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(57) mm <»ie«) 

©rs^4»5 w«kDW«wi^4Jii7 mBvmmttai 
torn®** ssr^s < -r a «fc 5 Kftwr *jb i ~~t& 
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C2) 



#8^5-2 2 8 8 6 3 



im^m i ] m i wmnmrni Mmvimvmmzm-r 
- $<DftiSim>n 5 wssftsifi 7 Ri8&© 3 ®<dwb&%. 

t,>KP-A • tT** • P-A<©W#{t**iikK:^5 
|»07!rMS&7M«5©fflSf5«l*i-- Wte*U 

7 B8«S(C«SI3 ftfc#5te©SSi&* S«£»{Cg£5 i5K 

■s * mm? * *> ©-c * o . tin bmkbkm: Mta#5t© a 

«»^-2»^S»SIK 4 . lffly&S©BtMfc«©fB «* 0 
JIHt ZfctiXDm 1 M«57!jMS&4 MfflS©Mffl5 
ftK©f&# 4Sff 5 M«S<DRI8iS«^lS| 4 * 7 WgB©M«S«| 

^tsi i ©-rft©*# s */m < r -5 <t 5 tcfww *s& 1 

^7S^4H«©H«**©0^i*S«U Cti6 
Ofift^jSoHUr* 1 M*p7l>M#4Mffi©SiaWf5£l£ 

sB&a^»sao?siJti»s*tc j: d i mmnmm i mm 
(ommft&*M®-t?>tempim.M®mm±zm*.. wis 
tt.»m*mmit. *5MP©mMii£ffl4iwMK©H 20 
«*wifli t ©-r ft©* # s &/h 3 < f * <t 9 Kff »r 4 

5 MfiiSODMSSf*^ 4 0 7 Mg50M«5«^(fiJ 4 ©f ft © 
[f»*H2 ] »5H8fii<DiagiStt^[$Ii^7KISiiCDM«i5Wi 

^4©rn©**s*4vs<**J:5Kfiwra*i 30 
mnm.m 1 mmawmnmowmmnmfr h ©ism t 

IM4©tt±fctte©ttfcW*S«fctt«-r*c4*W 
tits in*® 1 jcets© ^f a i — * SHHSPisa,, 

[0 0 0 1 ] 

mm±<DwmftW] nimmnrnxmB 

K>. mc. ©3fejfia»©*5|!8flS7!rS»7 40 

W?,iifcKf5 WflSftMSB 7 HflKDHffN** — ~> 
©SEjSjMTU MKM»SIK»IIG^©ttK«S«ffi 
SJCg£ 5 J: 9 «c*»oJH 7 M^«c«#3 n/c^5t©S5»^ 

[0002] 



SU© 3 ffl©M®S©RI8S#*s— i 0 Cft £©M 

[0 0 0 3] C©J:9J8:8«DflMi*#T*v;ie*U 

-*©jfe*K**3ftfc*4fett. '-Kal/-jt#6S 
fiffiSrWt^/tiWc, v-f* lx-^©«lf^l5HF*J(C*> 
*RR 9 . 3 ^7C^IUl©ff«©f4**Ji D^5»4H«-r 4 

[0004] ax. v^bTa u-*»MBfiWi. nees 

ftfc BiftSKfc J; tfB1S5£sf&£*-riS«fI£&Klgii©KI 
»ft *©«kimb» o r @«MS5ftg**#>> awe c 

ft 6 ©@«MI55ft0E*^Tr 4 J: 9 K&WffiS*** Wffinr 
4. 

[0 0 0 5] ifciW©3«©H»*a-*A' - t^-o 
- ;l/©M^(C * 4 c ft h © f a U - £ *s @« 4 r -5 

2 o©-¥> 9 <#*-€>ft*. 

[o o o 6 ] -r^ct?^. -ott7-f*u-^o^© 

5B6fi«i*lftfi»i*««PB«if*«>©. «»3fc« 
SP© 3 fl©Hfll©Hff N©^H©fiW ivr.f3.lx-* 
©5fe48^i&i£*J«BB«£r6 fe©-C*£. 
[0 0 0 7] »#©*i^. -r&to^5fe4»»©3ffl©fl8© 

©w«*©j&a©ttK*B«a«{c b*o-r - e » 

*©5ai©«l»*B««l*«:*4«^*ctt» vxf*u 
- * ©a3«aiS© 3 ffl©MfflSCCj; -p T ggUfjU! L , 

Missis© 3 wmmx. £ -oxmm<m%mm-r2> c <t k 
at*. c<D-k#>, *«aj©3ffl©iw©<fc5feiSSB©3#© 
W*4*^HL/t:*9ci*fr**©r. B«<4fiteJ: 

D*B«6IW»6B«IW»ftlt**»*fc«>©K«8B»* 

Satctf^ct*5-r , #*„ 

[0 0 0 8] jft*P> WS(S»l«W**6«>i L-T 7 fi 

©MIP?:Wt4-7- h* * U- 5» ^BB%3 ft*&*T l» * . 

[0 0 0 9] v^K»U-**«WB«4'*-SS«fiM 
*s*0*B«3S»->-»iJfflr-C**fc«f){C«, 

tt6ffl©M«5*5rrft«+^t?**. se-o-r, 7<H©ia 
a«sg»*3eH-r*fc*©i«»ft«w-«K:j***^* 
!gj©@ifi, i«©*i»sg»©i^**t*» ! i$i*sfii*©@ 
[ooio] mmmommtte. &&imis£vmmk 

b «C36«fr©9g»*IC<t s * * C 4 <c J: o fc* 

»i/-*©y>^*«i»»fii4»ir*c4«i»«c4"c 
**. 

[ooi i ] »sa©ftc»s^©»H4». **ia 

»©M®ftBt3&JDfflMeHIR^ifiK*-C-C#*^Wj*L 
^t^Jr^ic. a«tta*Jj:CXB*sS»**3»-C#*«^ 
©H»ftflE*6a^«cBMiftlt*a»?-i _ * C 4r#>*. 

Bffl©iH«*w-rft(3r5j«MeHi*i©e«©ttiK 

k J: -a r » 7i e * u - * asa* & mm<D&§ktc tt * c 



(3) 

3 

temm* c ©3&f*AW©i6# 7 mom®* 
*c*»t»r*>. 7iB©BOE£*Jjrrac4(c«fc^-c«ia© 
[0 0 12] Sfc. «ei©«ci»§g»tt, 

v i f A u - * © njwjwmtm < 'a £ -e * 5 „ 
[0013] ^^noaaitB. «*.«««*© 

[0 0 1 4] _kSB©J:9K:. 7«©W«**TSvj.tf 
[0015] 

[»»36*lll«0«t5ir*ll«l] Cti* 20 

-cff^M^snr*/c7«©Mfip**-rs^"t^ u- 

* t*MFft©B8K:*UJ&'r -5 ©**« 4^ 4 'X * -3 fc. 

*©i*if*©^-K»U-4r©W©ft** 
WW3&>6«)£L-CBW*l|3B - rS©*©*>©t?*-3^:. 
[0 0 1 6 ] ftiX. 1Wf&f*#ft**&t>Jft&tCi2. "7 

- 1- * u - * 1 ®<dwb zmr 5ci*+»K 
-c*s^»«wi©ft(r>s»*iai-r*v-e 
«fccie@«se»*i^-r*i««sftfl[©*-c**>*i8i©&^ 30 

[0017] *zx*.&m<Dmmx. _Lseti!*&»s©*r 
-r^WS^ftSiL. S«fcWs J: 

H*©B«Httftlt*fltirra b' » u — ^iHJffll^S 
£«t£T£C4-C*£„ 

[0018] 40 

U- *©^4&a5©l»5 Mfi&TbMaS 7 IH86© 3 <I©I»88# 
StHCD-;l/- ■ n-Jl/©ra<&&c*£4 4fe«t£ 

5 MffiTb^m 7 BBgi5©Mg5**aJ — 3©3&££ M l> . MTI2 
Mtm«»MGS^©fi««S*«aiU:|£9 «t 5 (cfro 
£ 7 ISJ« tcSeiT 3 ftfc^fe©*»*B«e»tctt 5 J: -5 

k& * mot s *>©•?& »j . m&mw&mim&.tt<D 

B«^©fficfc 0^5 MgBTbS* 7 Mgi5©B«Wg5ft& 50 



#^5-2 28863 
4 

*m*r z mmmxmm t . «rie3&5©g«ti*©tt<J: 

"3 g#fittB*IS5W--&fc«>©Si 1 Mg67bM»4MS5S©M 
fitftffi©^<5:JB5|!Bffli©W®f*^l£*7IHffl!©BBiJ 
H^4©rft©**3*'h3 <T*£5tefMi-r&* 
HW»7iM*4K«©Mttft*©JfiE»4*ailH^. Cti 

6©ja»tjBiiiH/rgii«i»7is*4w»©a«w»fl 
mfc&Mmnmm<Dmn£i&ic£ »> * 1 wffls7bMf&7 m 

»©MSltftffi€:flfl»r-5M»«lSflMISi««t*«^. Sir 
§2fi[aM#«S«, £5Mffi©M®ffc?n6j4Sft7Mgi5© 

w»«fc&iflii©Tn©/c*s*'h3 < 5 tcflMBf 

1 K«7i5JH4M«©BWBft*©R6»©^:* 3*. 
9 5 W«S©rag&*ltf/ft 431 7 Hflt©H0ft£ffl 4 ©Tft 
©^*S(cj6CTSa*3*SCitcJ:or. HSlMgi57!> 
MS& 7 Rffi©Rffft 0E©S*Hffft K*> 6 ©& * 
©*:* 3 *SW3£«H«: * 4 J; 5 tc£ 1 M857iM£ 4 Hff 
©a«W»ft**W»-r* C 4 £!BH84T£o 
[0 0 19] 

[fPflf] v-KaU-*©jfeii»©tll5Wtt75S*7M 
fSf©3ffl©W®*«Ec»K:p-;i/ • • a-;i/©IRI^ 
ic£>S 4 4 4>ccm5 Mlfi7!iM*7 Mffi©Mt5«* s — 5© 
*©"C> ftffi®<D& 5 MffiTbM^ 7 BUSS© 3 
fl©H0fcJ:-?'t:BaiXf»£atigU ^SSaP©^ 1 RlfiS 

7is^4 Mffi© 4 m<Dwmt£ -o x mm&z&n i> . 

SfciSBIS© 3 <I©M85 4 ^SSB© 4 ffl©KI«iS 4 U r 

mM®ft&%&#>ztctb(DmM$mz®mtcft *> c 4*« 

[0020] ttraflMBsattKftjgH-rsfcfe© 
miMKs7!iS£4Ri8e©M®fts©)S^©*fte>r 1 m 
5 Mg6©iat5«*ifi] 4 si 7 iwge©iwg5ii^ifii 4 ©-rn© 

®©Mgpftflf©fiR^*?ISIf L/, cn6©ES^%»n*L>r 
£ 1 Mfi57bMSMMfit5©SSMffift£*«*ri-£. 

[0021] s (4HS#»iB», mmzmzmjE. 

1 R|gii7iM04 M«f©4ffl©MflS©»bfWD-aS 
flttWIUT. £5M»©Mf85«l^l4»7Wa©IW» 
**^|fij4©-rn©A:#S%/hS < -T4 i^KfffflTS* 
lH»7>SW4BI»©HIWIIt©«*»©^:*3*. £5 
lfflffl5©M05l*^r&I 4^7 M«iS©MfflSf|l|^r&I 4 ©m©?t 
*3(CtED-C^«j3-&-SC4{cj;^-C, £ 1 HBgfi7!rM£ 
7 M»©W«Wlffi©tti»W«iffcffi*p6©£ * ©<SM©^c 
# 3 *ifr«l6H * «t 5 K» 1 M8S7!)Sm 4 M«S© S 

[0 022] 

©-SaSfJ^H 1 *s£Zm2Z&MLXmWirZ>. 
[0 0 2 3 ] EI2tCmTJ:5 5c. 7<H©BB85* : &-r-5v 

;tau-$ i o*sg£2 oKm^f^i-t^n-ci^. v 

1 0©7«©Rlfflltt > *iSg|5©m 1 1 



(4) 



W5-2 28863 



17!rM3P4IS«P 1 4©4ffi©l»g&£, 5fcffig&©lfl 5 Mg5 1 
1 5 7IfMm7M86l 7CD3ffl©M©<!:^P»^S. 3I7IW 

[0 0 2 4] 02 (B) CUi, S&lMgn 
^7M©1 7©flt^M«*5«lBSe<)^3nruS„ 

[0025] v-t^v-an 0©5feS8sa5©m5i«aJi 

5, »6RIg6l 6feJ:^7M«5l 7©3ffl<DMg5{*S 

mi KB 17 <DB9SSS«l^ 1 7 a «*5fc2 1 ©5fc4|g:frft 
tC[6j#, *>of6Ht 1 6 ©WfflSlfcfrfa 1 6 a tmAiC 10 

3f5M«5 1 5©WgjStt#fal 5 attf6|| 
gp 1 6 ©MSSffcfrSj 1 6 a igfiK* •) . #>offl 7 Mgp 
1 7 ©WSiffcSft 1 7 a<fc|g)-¥H±&i:*&„ @2icte 
815118851 5 CDKISStt^roI 1 5 aiH7MfiSl 7 
OMWKl^ 1 7 a itt-mt* &Tt«K*ii*L"Cl,»* 

a*. -Hate 5 sign 1 5 omwmyj&i 1 5 a t m 7 

gpl 7©MgWlltf>|Sjl 7ai«fntC>5. 

[0026] assuage 1 5. memmi e&jzv 

f& 7 BHfifi 1 7 © 3 <B©M«S©MglS*ill«— ?© 2 2 * 
*tr-5„ 20 
[0 0 2 7 ] 1 0<DtiL&<Dfflmt&t h 

2 2 fcillR U Vital/-* ©«^©*l|ffll>tf& 

-^10 2 2 ©ftB&gfcteBKffi ' «* *> 

l©*ft*@«»*tcfl£9J:9«:. v^tf^u- 

*fWffi££a 1 fc J: ^T*H»©B«W»ftK*»HEbM 
[0 028] 1 K7-t 3 U- »MmtB 1 ©SI 

[0 0 2 9] BlKfc^T, V-f3.U-$ft(Ha^etl 30 
2 ©g«<aB©fii<fc Q* 1 HV 1 1 75M^4K 

is 1 4 © g£M«isft &zmn* & c «t km* 

^*2i. l©B«fi»«D«J:«3t»5BWil5 7J 

SH7Mg0 1 7©S«WIfi5AS*Slfff S»9»«JHHi 
3 t . (4KvH#JIS 2 *s<fc t*fc»«»tSIB 3 ©aJKtt» * 

X- f C0) 



-f(f1.f2J3r 



[0030] ycK. Hi*#JHi/r-^e»u-*«MP 

i ©fp^Kot^riiwr*. 
[0031] &s.m&&m.2 ccti^2 2 ©<48©f§>£ 

[0 0 3 2] (&Biftt|t§tK2»&J&2 2©g*<ftB©tf 
£•5. S«tta4H*-r5fc«t)©»l|iBg57iM^4|«8iS 

«I©IWfi5liW^i^7Mfflf©MiIfffc&l^i©-rft©^* 
3 < ?*> «fc 9 KfEffl-f 1 Wg07!>M^4 Mgp© 

w«ft*©(fc»T*s*2i«»B tfcais 
#^g2 \$m i m^-trnz^t^mw-Lxm 1 wss^ 

£* 4 W«ii©@«IWgiSft& *»*T * . 
[0 0 3 3] */e. ffi««iBt«2tt»f2JSd6©^:* 
3 5 Mge©Mffi«r^|6l if7 HflSCDHIMttrlfil £ © 

MSTbM^ 7 nff©Hftft£©tt!*HftMK*>6©«« © 
■*©B«H»ft***JM-<&. 

[0034] wammm 2 *j «t u%fM**&a 3 ©* 

ir*S*ttMffiA«*II8ll^B4icA^5ftS„ WgiWKflJ 

©S& 1 WBas^MUr 7 Mg&©Mf8ifc &*!WfflJ-r 5. 
[0035] MTK$&Z*m^X±&(D1*1®$:mmir 

[0036] S«j|[2 2 <0&M^9kir&Mf<9 h**x, 

fli 1 was 1 1 nmm4 mm 1 4 ©H0fti£*ft'9'Mflfft 
19 hjieommtt ( 1 > ©.t^tcsi^f tatci 

[0037] 

[«ki ] 



f 1, f 2*»«fc0tf 3tt»*f KWr*SBWliS» (2)T«Sh4Hff#)Sit5. 
«r*T 0 [0 039] 

[0 03 8] &a-<? h^x©SS/J^ft*Ax«t5« [»2] 

4X= ICQ) -AG 

jc@; = Vafc/aep Ci- ;,2,3; --4) (2) 



(5) ^¥5-228863 

7 8 
[0 040] #tC5£ (2) £9. Ax^^nfcii* * [0 04 1 ] 
©A0£3j?fe&IKM*%5fcaf>£„ CCOmmtH (3) <DJ; [&3] 

40 = J"~(8)-4x + CI-J~(0)-J(6))-k (3) 



k : (4X1) 0ffig/?7Nb 

i • mm 

[0042] *f, 5$ ( 1 ) *fflt>-C?f|lfflgi57!rMSf!4 [ 0 0 4 7 ] ® 2I$#W3&£2 2 ©fiK©^b(C^6 

^-^ o *i ^©J;^(C595cU-C*>^2 2CD&S«^tU& 
[0043] :*Ctftj£2 2 Ji&fiH 

£<DMAx£#«6fcf£. ^ (3) K^otAe*** [0 04 8] £©^2 Jj£#©W^&ttt?*#JfflL-C. « 

20 TVXSlcLX^i? h;Uk©M*£tiJTSC£!£J:9. 

[0044ia(3) 3&>6»abfcAe^fi©ll9fii5ft SS5IWfiil 5 ©MSSffcfrlfij 1 5 a £SI7K]«5 1 7<D|»gfi 

mcm-SCi(cJ;«3. miM«57!rM»4Mg!i<Da«M ffcfrft 1 7 a £<D"f ftfcr^/cW/hS < TSJ: 5K, 

g5fc&*s#*>ftSo S&lMfiSl 17!fS^4Mt514CDS*g|l8g5ftS43¥ai-r 

[0 04 5] ft*. AxOWW<&5iS(3) 

KBKttSfcftOfcl*. L*»U -r-KaU-*««Wtt« [0049] (1) 3^fc2 1 OS«§0»Otf^6. * 

ltttmsec^lslOmsectl^^Ifflt?!! 7MJ8S 1 70MMft#M 1 7 a©*^* h^P = (p 

tiiluH-Ht^f c<D®c^»!^Flffl{c*ji,>-c«A l, P 2. P 3)*!sa^-i. cc-c, pi. P2. p 

[0 0 4 6] ^ (3) ©*2K:tet>T. m^tt3&£2 [0050] (2) S& 5 tWfiB 1 5 ©MfflStt^ft 1 5 a 
2©@*R{4a©fliJ;*)aSffiB*l|31-r-?)/c»©»lRI 30 ©SMS^* Ml<q = (al, 02. q 3 ) £S& 1 W8B 1 

® 1 175S»4IWgifl 4©M«5ftS©^-c$>€.^lsS; 1 TbmSUteB 1 4<Dl»giia£0 i (i = l~4)T^ 

# (HI tc*»WS«F#5) 3I2JS«SII5 Ufc*>©*q = (0 1. 0 2. 0 3. 0 4) tSZt 

mm 1 S<DMB#(tifal 5 a£3g7WSn 7©IHW*# *. 5£ ( 5 ) *SS/cTJ:^{C^i' h;bk**tf)^„ 

fti 7ai<D-rn©^*s*^§<-r-5<t^tcf¥ffl-r'5 [005 1 ] 

k1 = - 3L/361 

K2 - - dL/382 (4) 
k3 = - dL /303 
K4- " dL/994 

CtT?. Uii&tt^ h;Up = (p 1 . p 2. p 3) t ★ [0 05 2] 

Wl/q = (q 1 , q2. q3) i©SI"C* [£fc5 ] 
•3. 5£ (5) &Cj;o-T:*$ftSo ★ 

5$ (4) <Dit#B. IHIJa«rfWW*$etS rtt*Jt*li 5$J <DI2*W© (4. 6) ScDStgL^ff-pftiCtfctBS 

aj. vol. 25. no. i . ^mt!5fc» rojK 9 h -rs. 

r-A£D$uiffiW^j ©s?i2if:/£x*©s*«itltfcp£L [o o 5 3] tctdL, #^JfeWtfct,>T«. rn#? h 



^©-c, s; (4) <Dmimcnnn*m~t-c$>z, 

[0054] jC(4) lz£*)W\&\st^* h;Pk£ffli> 

■c. ^ (3) ttfctt£jji2sfcft**tf>£. -etr, ^ 

(3) fcfctvc. ?|llj£#££2jfca£©*a*M#l<T 
A0^*-S„ _t3£l-fcJ:5K:> 5£ (3) #>6»ffiL,;fc 

^4Mffi5©g&MgB#£*#tf>S. cntciO. Hi 5 
IfflgfS 1 5 ©M«5«l#ft 1 5 a iff* 71886 1 7 ©58014* 

ipji 7 a<t©-rn*-c^5fcw/h$<-r^j:^tc > ^i 10 

[0 0 5 5] JWTfc^ h^k©^?©^©^^ 
IfcBJTr*. fcfc. ^<i> h)lk<DJ:Z$l,t& (4) (C*5tf 

[0 0 5 6] s<i> b)lk(DJ:ZZte'X<DC£*ffitc~?J: 

[0 0 5 7] (1) v^fa l©$fc*88l5©3<I 
©Mfi5-r*-5^5|«|fi5l 5 7bMlfl7Klg51 7©Wg&ftS 

^^t = C65- 650,86- 660 



(6) #69^5-2 2 8 86 3 

10 

5£ (3) tCteWSSfi2»j!t#%it*S-fct£<i:5 

© 1 5©K«e«l^ 1 5 a £S&7 mfi 1 7 ©IHgSffcfrtSj 
1 7 a£©Tft#18£Ct*t< &SCi«:Ki±t4Ci 

[005 8] (2) v^-f^lx-^ l©S«SP©4ffl 
©IWfflS-C*S» 1 M05 1 1 rtMfMMiS 1 4©l»g&ft£ 
**S?tlftS*>6>*:#<*tiSK:-onr. a£ (3) tcfctf 
2 fi£#£«4>3 -ii S J: 5 * h * k © 3 
C*UC<fc^ m 1 PHfiS 1 lttMSMIWffiSl 4© 

[0059] >Xl£. ±&© ( 1 ) *J<fci>* ( 2 ) SrjftfcT 
J^Sc'** ^^©^^©aS^co^-C. 5£ (6) 7b 

[0 0 6 0] 5£ (6) K. 5yggP©3ffl©M«pr*S» 
5 MSB 1 5 7W85 1 7 ©MSSft CS©S*ft «#> 6 
©{B^e? hJUAQ t „ 
[006 1 ] 

[fte] 

, 67-670) (6) 



610 : m l WIHPWIi* (1-5.6,7) 



»*SSi5©4ffl©KI8p^*-S» 1 M«5 1 1 Tb^m* * [0 0 6 2] 

mns 1 4 ©wg5«af©«*ftef*^©iBM^^ h ;va e mi ] 

4 0r = C0 /-eW, 62- 620, 63-630, 64-640) 



(7) 



810:*LJIMHPPM 

^iC 5t«j}gS© 3ffl©Rlfi!5©M«i5ft«©»r|lft)K*>6© ★ [006 3] 
iEftfctI^£i?1ililWftL t *Si (8) fc«fc-»-CjeftT [ft 8] 
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(54) MANIPULATOR CONTROL UNn 

(57)Abstract: 

PURPOSE: To facilitate a coordinate transformation finding a desired 
joint angle out of a desired position and a desired attitude by setting 
plural pieces of joints in each tip part to a relationship of roll-pitch-roll 
with one another, while adopting such a means that one intersection is 
set in each joint shaft of these joints and so on. 
CONSTITUTION: A control unit 1 of a manipulator with seven joints 
operates a desired joint angle of each of first to fourth joints at a 
position arithmetic unit on the basis of a desired position of an 
intersection being forced by a joint shaft of each of fifth to seventh 
joints. At this time, not only a first component 5 pertaining to a joint 
angle of each of first to fourth joints but also a second component 6 
pertaining to the joint angle of each of the first to fourth joints for 
reducing the axial slippage of these first to fourth joints are operated 
together. In addition, on the basis of a desired attitude of a terminal 
attached to the seventh joint, the desired joint angle of each of the fifth 
to seventh joints is operated at an attitude arithmetic unit 3. 
Furthermore, on the basis of respective operational results of each 
arithmetic unit 3, the joint angle of each of the first to seventh joints is 
controlled by a joint angle control unit 4. 
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* NOTICES * 

JPO and INPIT are not responsible for any 
damages caused by the use of this translation. 

1 .This document has been translated by computer. So the translation may not reflect the original 
precisely. 

2 **** s hows the word which can not be translated. 
3. In the drawings, any words are not translated. 



CLAIMS 



[Claim(s)] 

[Claim 1] It is the control unit of the manipulator which has seven joints of the 1st joint thru/or the 
7th joint. While three joints of the 5th joint of the point of said manipulator thru/or the 7th joint have 
the relation of a roll pitch roll mutually, the joint shaft of the 5th joint thru/or the 7th joint has one 
intersection. Said control unit is what controls respectively a hand's posture with which the 7th joint 
was equipped so that a target position might be followed in the location of said intersection to follow 
a target posture. The posture arithmetic unit with which said control unit calculates the target joint 
include angle of the 5th joint thru/or the 7th joint from the value of said hand's target posture, The 
component of the joint include angle of the 1st joint which acts so that the gap of the component of 
the joint include angle of the 1st joint for realizing a target position from the value of the target 
position of said intersection thru/or the 4th joint, the joint shaft orientations of the 5th joint, and the 
joint shaft orientations of the 7th joint may be made small thru/or the 4th joint is calculated. The 
location arithmetic unit which adds these components and calculates the target joint include angle of 
the 1st joint thru/or the 4th joint, It has the joint include-angle control unit which controls the joint 
include angle of the 1st joint thru/or the 7th joint by the result of an operation of said posture 
arithmetic unit and said location arithmetic unit. Said location arithmetic unit The magnitude of the 
component of the joint include angle of the 1st joint which acts so that the gap of the joint shaft 
orientations of the 5th joint and the joint shaft orientations of the 7th joint may be made small thru/or 
the 4th joint By making it change according to the gap of the joint shaft orientations of the 5th joint, 
and the joint shaft orientations of the 7th joint The manipulator control unit characterized by 
calculating the target joint include angle of the 1st joint thru/or the 4th joint as the magnitude of each 
deflection from the criteria joint include angle of the joint include angle of the 1st joint thru/or the 
7th joint is in the predetermined range. 

[Claim 2] The magnitude of the component of the joint include angle of the 1st joint which acts so 
that the gap of the joint shaft orientations of the 5th joint and the joint shaft orientations of the 7th 
joint may be made small thru/or the 4th joint The manipulator control unit according to claim 1 
characterized by being proportional to a ratio with the distance from the criteria joint include angle 
of the joint include angle of the 5th joint the distance from the criteria joint include angle of the joint 
include angle of the 7th joint and the 1st joint thru/or the 4th joint, or the amount about this ratio. 



[Translation done.] 



http://ww4.ipdl.inpit.go.jp/^ 1/14/2008 



JP,05-228863,A [DETAILED DESCRIPTION] 



Page 1 of 8 



* NOTICES * 

JPO and INPIT are not responsible for any 
damages caused by the use of this translation. 

1 .This document has been translated by computer. So the translation may not reflect the original 
precisely. 

2.**** shows the word which can not be translated. 
3. In the drawings, any words are not translated. 



DETAILED DESCRIPTION 



[Detailed Description of the Invention] 
[0001] 

[Industrial Application] This invention relates to the control unit of the manipulator which has seven 
joints of the 1st joint thru/or the 7th joint. While three joints of the 5th joint of the point of a 
manipulator thru/or the 7th joint have the relation of a roll pitch roll mutually especially, the joint 
shaft of the 5th joint thru/or the 7th joint has one intersection. Said control unit is related with the 
manipulator control unit which controls respectively a hand's posture with which the 7th joint was 
equipped so that a target position might be followed in the location of said intersection to follow a 
target posture. 
[0002] 

[Description of the Prior Art] Many manipulators which have six joints centering on the industrial 
robot used in works are used. As for the manipulator of these many, intersections and these joints 
have [ the joint shaft of three joints of a point ] the relation of a roll pitch roll by one point. 
[0003] The hand with whom it was equipped at the tip of the manipulator which has such six joints 
can realize the location and posture of arbitration of three-dimension space, as long as it is in the 
operating range of a manipulator, since a manipulator has six degrees of freedom. 
[0004] Usually, a manipulator control unit carries out coordinate transformation of the coordinate 
value showing the specified target position and a target posture to the value of the joint include angle 
of each joint, asks for a target joint include angle, and controls each joint shaft to realize these target 
joint include angles next. 

[0005] When these manipulators three joints of a point have the relation of a roll pitch roll tend to 
realize target location and posture, the following two ways are usually considered well. 
[0006] That is, the thing and others to which one makes control objectives the tip location and tip 
posture at a tip of a manipulator make control objectives the location of the intersection of the joint 
shaft of three joints of a point, and the tip posture of a manipulator. 

[0007] Case [ the case of the latter ], i.e., when making the location of the intersection of the joint 
shaft of three joints of a point into a target position and making the posture at the tip of a manipulator 
into a target posture, three joints of the end face section of a manipulator will prescribe a target 
position, and three joints of a point will prescribe a target posture. For this reason, since three joints 
of the end face section and three joints of a point can dissociate and treat, coordinate transformation 
for asking for a target joint include angle can be easily performed from a target position and a target 
posture. 

[0008] On the other hand, the manipulator which has seven joints including the object for researches 
and developments is beginning to be developed in recent years. 

[0009] In order for a manipulator to be controllable to the target position and target posture which 
are made into control objectives, if a manipulator has six joints, it is enough. Therefore, in the 
manipulator which has seven joints, it is not decided that the joint include angle for realizing a target 
position and a target posture will be a meaning. By using this one remaining degree of freedom, 
evasion of an obstruction, implementation of the impossible posture which is not, or evasion of a 
unique posture can be enabled. 

[0010] Evasion of an obstruction is preventing the link of a manipulator colliding with an obstruction 
by realizing a target position and a target posture and changing the posture of ****** . 
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[001 1] Moreover, implementation of the impossible posture which is not is choosing a suitable joint 
include angle from the various joint include angles which can realize a target position and a target 
posture, as the joint include angle of a certain joint does not reach even near a movable range 
limitation as much as possible, although the location and posture of arbitration of movable within the 
limits are generally realizable if it has six joints, it takes that a manipulator becomes a quite 
impossible posture depending on the value of a target location or a posture — it has carried out for 
taking. Human being's arm does not take a usually not much impossible posture. Negative requires 
this reason for human being f s arm having seven joints greatly. In a manipulator, the impossible 
posture which is not is realizable by using seven joints similarly. 

[0012] Moreover, the impossible posture which is not is a posture realized by making many joints 
contribute as much as possible. It is because there is movable range in each joint, respectively, so it 
is restricted by the movable range limitation of the joint and the movable range of a manipulator 
becomes narrow to incline only toward a specific joint and to make it pay the actuation for realizing 
control objectives. 

[0013] Moreover, evasion of a unique posture is that two or more joint shafts avoid coincidence or 
becoming parallel. In such a unique posture, it is because it becomes impossible to realize only the 
degree of freedom of one piece at two or more joints. 

[0014] As mentioned above, the manipulator which has seven joints can use one excessive joint in 

order to realize the various purposes. 

[0015] 

[Problem(s) to be Solved by the Invention] However, it was almost the case which uses for evasion 
of an obstruction the manipulator which has seven joints research and development in has so far been 
done. Or the include angle of the elbow of the occasional manipulator was specified from the 
outside, and it was the thing of only realizing the purpose. 

[0016] Therefore, when there was no special obstruction, it did not fully use having one joint with an 
excessive manipulator. Moreover, even if it did not give desired value from the exterior, the 
manipulator which realizes the impossible possible posture that is not was not able to be seen. That 
is, the impossible target joint include angle in the joint include angle which realizes a target position 
and a target posture that is not was computed, and the manipulator control unit which controls a 
manipulator to follow this target joint include angle could not be seen, and did not fully use the 
redundancy degree of freedom. 

[0017] Then, the purpose of this invention is offering the manipulator control unit which calculates 
the target joint include angle of each joint with the posture of a manipulator impossible for which is 
not in the joint include angle which solves the problem which the above-mentioned conventional 
technique's has, and realizes a target position and a target posture. 
[0018] 

[Means for Solving the Problem] In order to attain the above-mentioned purpose, this invention is 
the control unit of the manipulator which has seven joints of the 1st joint thru/or the 7th joint. While 
three joints of the 5th joint of the point of said manipulator thru/or the 7th joint have the relation of a 
roll pitch roll mutually, the joint shaft of the 5th joint thru/or the 7th joint has one intersection. Said 
control unit is what controls respectively a hand's posture with which the 7th joint was equipped so 
that a target position might be followed in the location of said intersection to follow a target posture. 
The posture arithmetic unit with which said control unit calculates the target joint include angle of 
the 5th joint thru/or the 7th joint from the value of said hand's target posture, The component of the 
joint include angle of the 1st joint which acts so that the gap of the component of the joint include 
angle of the 1st joint for realizing a target position from the value of the target position of said 
intersection thru/or the 4th joint, the joint shaft orientations of the 5th joint, and the joint shaft 
orientations of the 7th joint may be made small thru/or the 4th joint is calculated. The location 
arithmetic unit which adds these components and calculates the target joint include angle of the 1st 
joint thru/or the 4th joint, It has the joint include-angle control unit which controls the joint include 
angle of the 1st joint thru/or the 7th joint by the result of an operation of said posture arithmetic unit 
and said location arithmetic unit. Said location arithmetic unit The magnitude of the component of 
the joint include angle of the 1st joint which acts so that the gap of the joint shaft orientations of the 
5th joint and the joint shaft orientations of the 7th joint may be made small thru/or the 4th joint By 
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making it change according to the gap of the joint shaft orientations of the 5th joint, and the joint 
shaft orientations of the 7th joint It is characterized by calculating the target joint include angle of 
the 1st joint thru/or the 4th joint, as the magnitude of each deflection from the criteria joint include 
angle of the joint include angle of the 1st joint thru/or the 7th joint is in the predetermined range. 
[0019] 

[Function] Since the joint shaft of the 5th joint thru/or the 7th joint has one intersection while three 
joints of the 5th joint of the point of a manipulator thru/or the 7th joint have the relation of a roll 
pitch roll mutually Three joints of the 5th joint of a point thru/or the 7th joint prescribe a target 
posture. Since a target posture can be specified and three joints of a point and four joints of the end 
face section can be separated and treated by four joints of the 1st joint of the end face section thru/or 
the 4th joint, coordinate transformation for asking for a target joint include angle can be easily 
performed from a target position and a target posture. 

[0020] A location arithmetic unit calculates the component of the joint include angle of the 1st joint 
which acts so that the gap of the joint shaft orientations of not only the component of the joint 
include angle of the 1st joint for realizing a target position thru/or the 4th joint but the 5th joint and 
the joint shaft orientations of the 7th joint may be made small thru/or the 4th joint, adds these 
components and calculates the target joint include angle of the 1st joint thru/or the 4th joint. 
[0021] Furthermore, a location arithmetic unit uses one degree of freedom of the remainder of four 
joints of the 1st joint which specifies a target posture thru/or the 4th joint. The magnitude of the 
component of the joint include angle of the 1st joint which acts so that the gap of the joint shaft 
orientations of the 5th joint and the joint shaft orientations of the 7th joint may be made small thru/or 
the 4th joint By making it change according to the gap of the joint shaft orientations of the 5th joint, 
and the joint shaft orientations of the 7th joint, as the magnitude of each deflection from the criteria 
joint include angle of the joint include angle of the 1st joint thru/or the 7th joint is in the 
predetermined range, the target joint include angle of the 1st joint thru/or the 4th joint is calculated. 
[0022] 

[Example] One example of the manipulator control unit by this invention is explained with reference 
to drawing 1 and drawin g 2 below. 

[0023] As shown in drawing 2 , the manipulator 10 which has seven joints is attached in the pedestal 
20. Seven joints of a manipulator 10 consist of four joints of the 1st joint 1 1 of the end face section 
thru/or the 4th joint 14, and three joints of the 5th joint 15 of a point thru/or the 7th joint 17. It is 
equipped with the hand 21 at the tip of the 7th joint 17. 

[0024] Moreover, the configuration relation between the 1st joint 11 thru/or the 7th joint 17 is 
roughly shown in drawing 2 (B). 

[0025] Three joints, the 5th joint 15 of the point of a manipulator 10, the 6th joint 16, and the 7th 
joint 17, have the relation of a roll pitch roll mutually. Namely, there is joint shaft-orientations 17a of 
the 7th joint 17 toward a hand's 21 direction of a tip at right angles to joint shaft-orientations 16a of 
the 6th joint 16. Moreover, there is joint shaft-orientations 15a of the 5th joint 15 at right angles to 
joint shaft-orientations 16a of the 6th joint 16, and it is on the same flat surface as joint shaft- 
orientations 17a of the 7th joint 17. In drawing 2 , although joint shaft-orientations 15a of the 5th 
joint 15 and joint shaft-orientations 17a of the 7th joint 17 show the condition of making a straight 
line, generally joint shaft-orientations 15a of the 5th joint 15 and joint shaft-orientations 17a of the 
7th joint 17 are shifted. 

[0026] Moreover, the joint shaft of three joints, the 5th joint 15, the 6th joint 16, and the 7th joint 17, 
has one intersection 22. 

[0027] An intersection 22 is chosen as a controlled system of the location of a manipulator 10, and a 
hand's 21 posture is chosen as a controlled system of the posture of a manipulator. And to follow a 
target posture, the target joint include angle of each joint is calculated, and a manipulator 10 controls 
a hand's 21 posture by the manipulator control unit 1 to follow a target position in the location of an 
intersection 22. 

[0028] Next, the outline of the manipulator control unit 1 is shown in drawing 1 . 
[0029] The location arithmetic unit 2 about the manipulator control unit 1 calculating the target joint 
include angle of the 1st joint 1 1 thru/or the 4th joint 14 from the value of the target position of an 
intersection 22 in drawing 1 , It has the posture arithmetic unit 3 which calculates the target joint 
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include angle of the 5th joint 15 thru/or the 7th joint 17 from the value of a hand's 21 target posture, 
and the joint include-angle control unit 4 which controls the joint include angle of the 1st joint 
thru/or the 7th joint by the result of an operation of the location arithmetic unit 2 and the posture 
arithmetic unit 3 . 

[0030] Next, an operation of the manipulator control unit 1 is explained with reference to drawing 1 . 

[003 1] The information about the target position where the location of an intersection 22 was 
specified is inputted into the location arithmetic unit 2 from the outside. Moreover, the information 
about the target posture in which a hand's 21 posture was specified is inputted into the posture 
arithmetic unit 3 from the outside. 

[0032] From the value of the target position of an intersection 22, the location arithmetic unit 2 
calculates the 2nd component 6 which is a component of the joint include angle of the 1st joint 
which acts so that the gap of the joint shaft orientations of not only the 1st component 5 but the 5th 
joint and the joint shaft orientations of the 7th joint which are the components of the joint include 
angle of the 1st joint for realizing a target position thru/or the 4th joint may be made small thru/or 
the 4th joint. The location arithmetic unit 2 adds the 1st component and the 2nd component, and 
calculates the target joint include angle of the 1st joint thru/or the 4th joint. 

[0033] Moreover, when the magnitude of the 2nd component 6 makes it change according to the gap 
of the joint shaft orientations of the 5th joint, and the joint shaft orientations of the 7th joint, the 
location arithmetic unit 2 calculates the target joint include angle of the 1st joint thru/or the 4th joint, 
as the magnitude of each deflection from the criteria joint include angle of the joint include angle of 
the 1st joint thru/or the 7th joint is in the predetermined range. 

[0034] The result of an operation of the location arithmetic unit 2 and the posture arithmetic unit 3 is 
inputted into the joint include-angle control unit 4. The joint include-angle control unit 4 controls the 
joint include angle of the 1st joint of a manipulator 10 thru/or the 7th joint based on the inputted 
information. 

[0035] A formula is used for below and the above-mentioned contents are explained to it. 

[0036] When setting to theta the joint include-angle vector which expresses the joint include angle of 

x, the 1st joint 1 1, or the 4th joint 14 for the position vector showing the location of an intersection 

22, the relation between a position vector x and the joint include-angle vector theta can be expressed 

with Function f like a formula (1). 

[0037] 

[Equation 1] 

x= f (0) 

-f (fl, fZ,f3) T (/) 

Here, T expresses transposition and is the same as that of below. Moreover, fl, f2, and f3 express the 
space component about f respectively. 

[0038] Moreover, the relation expressed with a formula (2) is materialized between the minute 
variation delta x of a position vector x, and minute variation deltatheta of the joint include-angle 
vector theta. 
[0039] 
[Equation 2] 

AX - 1(6) - AG 

1(d)- (dh/dOfi (i- 1,2,3; i=1,—4) (Z) 

Here, J (theta) is a Jacobian matrix. Moreover, thetaj is the joint include angle of the j-th joint. 
[0040] Next, it asks for the relation which asks for deltatheta when delta x is given from a formula 
(2). This relation can be expressed like a formula (3). 
[0041] 
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A0= J (6) 



[Equation 



Ax + (I-J-(e)-J(6))'k (3) 
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Next, how to ask below for a target joint include angle is explained. 

[0042] First, the current location of an intersection 22 is computed from the current joint include 
angle of the 1st joint thru/or the 4th joint using a formula (1). 

[0043] Next, after searching for the difference delta x of the target position of the location of an 
intersection 22, and the current position, it asks for deltatheta according to a formula (3). 
[0044] By adding deltatheta computed from the formula (3) to a current joint include angle, the 
target joint include angle of the 1st joint thru/or the 4th joint is obtained. 
[0045] In addition, if the value of delta x becomes large, a formula (3) will not be materialized 
strictly. However, since the manipulator control unit 1 calculates repeatedly a short period called 
several 10 msec(s) from Number msec, and the value of delta x is frilly small in this short periodic 
time amount, it is satisfactory. 

[0046] In the right-hand side of a formula (3), the 1st term expresses the 1st component (sign 5 in 
drawin g 1 ) which is a component of the joint include angle of the 1st joint 1 1 for realizing a target 
position from the value of the target position of an intersection 22 thru/or the 4th joint 14. Moreover, 
the 2nd term expresses the 2nd component (sign 6 in drawing 1 ) which is a component of the joint 
include angle of the 1st joint 11 which acts so that the gap of joint shaft-orientations 15a of the 5th 
joint 15 and joint shaft-orientations 17a of the 7th joint 17 may be made small thru/or the 4th joint 
14. 

[0047] The 2nd component is a component which does not affect change of the location of an 
intersection 22 at all. That is, even if it sets up the value of Vector k like how, the location of an 
intersection 22 does not change. 

[0048] Using the property which this 2nd component has, as it is the following, the target joint 
include angle of the 1st joint 1 1 thru/or the 4th joint 14 is computed by computing the value of 
Vector k so that the gap with joint shaft-orientations 15a of the 5th joint 15 and joint shaft- 
orientations 17a of the 7th joint 17 may be made as small as possible. 

[0049] (1) Compute unit-vector p= (pi, p2, p3) of joint shaft-orientations 17a of the 7th joint 17 
from the value of a hand's 21 target posture. Here, pi, p2, and p3 express the space component of 



[0050] (2) When making into q= (thetal, theta2, theta3, theta4) what expressed unit- vector q= (ql, 
q2, q3) of joint shaft-orientations 15a of the 5th joint 15 with joint include-angle thetai (i=l-4) of the 
1st joint 1 1 thru/or the 4th joint 14, search for Vector k so that a formula (5) may be filled. 

;oosi] 

Equation 4] 

(1 - - BL/361 

HZ - - dL/BBZ (4) 
k3= - BL /963 
K4- - dL/964 

Here, L is the distance of unit-vector p= (pi, p2, p3) and unit-vector q== (ql, q2, q3), and is expressed 

by the formula (5). 

[0052] 



http://wAVw4.ipdl.inpit.go.jp/cgi-bin/tran_web_cgi_ejje 1/14/2008 



Vector p. 



JP,05-228863,A [DETAILED DESCRIPTION] 



Page 6 of 8 



[Equation 5] 

L = (p1-f1) 2 -*- (p2-%2f-t- C p3 - q3f (5) 

count of a formula (4) - the Society of Instrument and Control Engineers ~ the performance index p 
of the 2nd subtask of "measurement and control" Vol.25, No.l, and Tsuneo Yoshikawa work "the 
control system of a robot arm" is permuted by L, and it is equivalent to having calculated the formula 
(4.6) under publication of "the control system of a robot arm" to this L. 

[0053] However, in this example, since he wants to decide the value of Vector k to make as small as 
possible the value of L which serves as a performance index unlike description of "the control 
system of a robot arm", minus sign has been attached to the right-hand side of a formula (4). 
[0054] It asks for the 2nd component in a formula (3) using the vector k computed by the formula 
(4). And in a formula (3), the sum of the 1st component and the 2nd component is calculated and it 
asks for deltatheta. As mentioned above, it asks for the target joint include angle of the 1st joint 
thru/or the 4th joint by adding deltatheta computed from the formula (3) to a current joint include 
angle. Thereby, the target joint include angle of the 1st joint 1 1 thru/or the 4th joint 14 is computable 
so that the gap with joint shaft-orientations 15a of the 5th joint 15 and joint shaft-orientations 17a of 
the 7th joint 17 may be made as small as possible. 

[0055] The method of a setup of the magnitude of Vector k is explained below. In addition, the 
magnitude of Vector k is given as a square root of the sum of squares of each component in a 
formula (4). 

[0056] The magnitude of Vector k is decided to fill the following thing. 

[0057] (1) Set up the magnitude of Vector k so that the 2nd component in a formula (3) may be 
increased, as it separates from the criteria include angle which is a joint include angle from which the 
joint include angle of the 5th joint 15 which is three joints of the point of a manipulator 1 thru/or the 
7th joint 17 serves as criteria greatly. Thereby, the gap with joint shaft-orientations 15a of the 5th 
joint 15 and joint shaft-orientations 17a of the 7th joint 17 can prevent becoming large to the degree 
of pole. 

[0058] (2) Set up the magnitude of Vector k so that the 2nd component in a formula (3) may be 
decreased, as the joint include angle of the 1st joint 11 which is four joints of the end face section of 
a manipulator 1 thru/or the 4th joint 14 separates from a criteria include angle greatly. Thereby, it 
can prevent that the joint include angle of the 1st joint 1 1 thru/or the 4th joint 14 separates from a 
criteria include angle to the degree of pole. 

[0059] Next, a setup of the magnitude of the vector k with which above-mentioned (1) and (2) are 
filled is concretely explained using a formula (6) thru/or a formula (10). 

[0060] The deflection vector deltathetat from the criteria include angle of the joint include angle of 
the 5th joint 15 which is three joints of a point thru/or the 7th joint 17 is shown in a formula (6). 
[0061] 
[Equation 6] 

Adt - (65- 650, Q6-660, 67-070) (6) 

dio - & l fmnmmnm a-5,6,7) 

Moreover, the deflection vector deltathetar from the criteria include angle of the joint include angle 
of the 1st joint 1 1 which is four joints of the end face section thru/or the 4th joint 14 is shown. 
[0062] 
[Equation 7] 
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A dr - C 6 1 - 010, 62- 620, 63 -030, 64-640) 



(7) 



8L0:*LHMb£¥fiJft 

Next, a formula (8) defines the performance index Lt which is equivalent to distance from the 
criteria include angle of the joint include angle of three joints of a point. 
[0063] 
[Equation 8] 

Lt - \Al'A6t\ 



- (A6t) T -At 
zz? At 



(Adt) 
r a5 o o 

0 a6 0 
0 0 a7j 



(8) 



Moreover, a formula (9) defines the performance index Lr which is equivalent to distance from the 
criteria include angle of the joint include angle of four joints of the end face section. 
[0064] 
[Equation 9] 

Lr = WAr-ASrW 



- (A6r) T - 


Ar ' 


Udr) 






'al 


0 0 


0 ~ 


ZT Ar = 


0 


dZ 0 


0 


0 


0 a3 


0 




_ 0 


0 0 


a4 _ 



In a formula (8) and a formula (9), a multiplier ai (1=1-7) is a weighting factor about which thinks 
the deflection from the criteria include angle of the joint include angle of the i-th joint as important, 
and is a forward constant. What is necessary is just to set all components as 1 like multiplier ai(l=l- 
7) =1, in order to make small deflection from each criteria include angle of each joint include angle 
about all joints. 

[0065] next, it is shown in a formula (10) - as ~ the ratio of Lt and Lr — it asks for lambda. 
[0066] 

[Equation 10] 

X - Lt/Lr (10) 

final — the magnitude of Vector k « a ratio — it sets up so that it may be proportional to lambda. 
[0067] Thus, while the gap with joint shaft-orientations 15a of the 5th joint 15 and joint shaft- 
orientations 17a of the 7th joint 17 can prevent becoming large to the degree of pole by setting up the 
magnitude of Vector k, it can prevent that the joint include angle of four joints of the end face 
section separates from a criteria include angle to the degree of pole. 

[0068] In addition, an impossible posture is easily avoidable when making it the deflection from the 
criteria include angle of the joint include angle by surrounding roll rotation of the joint shaft of the 
5th joint 15 and the deflection from the criteria include angle of the joint include angle by 
surrounding roll rotation of the joint shaft of the 7th joint 17 become a reverse sign mutually. 
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Moreover, when only surrounding roll rotation of the joint shaft of the 7th joint 17 with which it was 
equipped with the hand 21 is required, with surrounding roll rotation of the joint shaft of the 5th joint 
15 stopped, it is in the tolerance of the roll rotation around the joint shaft of the 7th joint 17, and it is 
convenient to take the posture of arbitration in any way. 

[0069] according to the configuration of this example ~ the magnitude of Vector k -- a ratio - since 
it set up so that it might be proportional to lambda, while the gap with joint shaft-orientations 15a of 
the 5th joint 15 and joint shaft-orientations 17a of the 7th joint 17 can prevent becoming large to the 
degree of pole, it can prevent that the joint include angle of four joints of the end face section 
separates from a criteria include angle to the degree of pole. 

[0070] Consequently, as the magnitude of each deflection from the criteria joint include angle of the 
joint include angle of the 1st joint thru/or the 7th joint is in the impossible range which is not, it can 
choose. And it can prevent enlarging only the joint include angle of a certain specific joint in vain. 
[0071] Moreover, the movable range of the manipulator 10 whole can be enlarged by this, without 
being restricted by the movable range limitation of the joint include angle of a certain specific joint. 
[0072] Moreover, since the value of the multiplier ai (1=1-7) in a formula (8) and a formula (9) can 
be set up suitably, weight **** can be carried out according to the tolerance where each deflection 
has the deflection from the criteria joint include angle of the joint include angle of each joint. 
[0073] Consequently, to the joint which wants to lessen a burden, when realizing a certain target 
position and a target posture, if, that burden can be lessened. 

[0074] in addition, the magnitude of Vector k - a ratio - although it is proportional to lambda - a 
ratio — even if it is not proportional to lambda itself — for example, a ratio -- a ratio, such as being 
proportional to the square of lambda, - what is necessary is just to set up so that it may be dependent 
on the amount about lambda 
[0075] 

[Effect of the Invention] As explained above, according to the configuration of this invention, a 
location arithmetic unit uses one degree of freedom of the remainder of four joints of the 1st joint 
which specifies a target posture thru/or the 4th joint. The target joint include angle of the 1st joint 
thru/or the 4th joint is calculated so that the magnitude of the component of the joint include angle of 
the 1st joint which acts so that the gap of the joint shaft orientations of the 5th joint and the joint 
shaft orientations of the 7th joint may be made small thru/or the 4th joint may be changed in the 
predetermined range. Consequently, the magnitude of each deflection from the criteria joint include 
angle of the joint include angle of the 1st joint thru/or the 7th joint can be in the predetermined 
range, and each joint of a manipulator can take the impossible joint include angle which is not in the 
joint include angle which realizes the target position and target posture of a manipulator. 
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* NOTICES * 

JPO and INPIT are not responsible for any 
damages caused by the use of this translation. 

LThis document has been translated by computer. So the translation may not reflect the original 
precisely. 

2 **** s hows the word which can not be translated. 
3. In the drawings, any words are not translated. 



DESCRIPTION OF DRAWINGS 



[Brief Description of the Drawings] 

[Drawing 1] The block diagram of one example of the manipulator control device of this invention. 
[Drawing 2] The perspective view (A) showing the manipulator used as the controlled system of the 
manipulator control unit of this invention, and drawing showing the configuration relation of the 
joint of a manipulator roughly (B). 
[Description of Notations] 
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[Drawin g 1] 
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[Drawing 2] 
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